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Abstract: In Compass/INS integrated navigation systems, feedback inertial navigation 
solutions to baseband tracking loops may eliminate receiver dynamic effects, and effectively 
improve the tracking accuracy and sensitivity. In the conventional inertially-aided tracking 
loop, the satellite-receiver line-of-sight velocity is used directly to adjust local carrier 
frequency. However, if the inertial solution drifts, the phase tracking error will be enlarged. 
By using Kalman filter based carrier phase tracking loop, this paper introduces a new 
inertial aid method, in which the line-of-sight jerk obtained from inertial acceleration by a 
nonlinear tracking differentiator is used to adjust relevant parameters of the Kalman filter's 
process noise matrix. Validation is achieved through high dynamic Compass B3 signal 
with line-of-sight jerk of 10 g/s collected by a GNSS simulator. Experimental results 
indicate that the new inertial aid method proposed in this paper is free of the impact of the 
receiver dynamic and inertial errors. Therefore, when the integrated navigation system is 
starting or re-tracking after losing lock, the inertial error is absent from the navigation 
solution correction that induces large drift, and the new aid method proposed in this paper 
can track highly dynamic signals. 

Keywords: high dynamics; Compass/INS integrated navigation system; inertial aiding; 
nonlinear tracking differentiator 
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1. Introduction 

The new Beidou (Compass) Navigation Satellite System network, consisting of five GEO satellites 
and 30 non-GEO satellites, is designed to provide positioning service with an accuracy of 10 m, speed 
measurement service with an accuracy of 0.2 m/s and time service with an accuracy of 10 ns within the 
whole global area. By the end of April 2012, 13 navigation satellites will have been launched. Some 
signal parameters of Compass were publicized in the 2010 Munich Satellite Navigation Summit [1]. 
With the establishment of the Compass network and the demand for current high dynamic applications 
such as spaceflight and aviation, research on Compass/INS integrated navigation system has been 
gradually receiving more intensive attention. In the Compass/INS integration system, INS measurements 
and Compass measurements are integrated using Kalman filtering to prevent inertial solution drift and 
also to aid the baseband tracking loop by adjusting local signal generation. 

The receiver's baseband tracking loop, normally, consists of a phase locked loop (PLL) for carrier 
tracking and a delay locked loop (DLL) for code tracking. Generally, the receiver adopts a third-order 
PLL, and loop parameters are determined with the controUed-root method [2]. Moreover, the PLL 
based on Kalman filtering has also been widely used. It is possible for the Kalman-PLL to adjust the 
loop gain according to the discriminator output, achieving adjustment of loop bandwidth, effectively 
reducing the loop's response time and restraining tracking noise [3,4]. In a weak signal and highly 
dynamic environment, the PLL without assistance can easily lose lock [5-7]. However, the integration 
system feeds the inertial measurements to the tracking loop, so the tracking error caused by receiver 
dynamics can be eliminated with the aid of inertial information. Therefore, the loop's bandwidth will 
be reduced and its tracking precision will be improved. Two factors which are seldom concerned need 
to be considered when using inertial measurements to aid highly dynamic tracking loops: 

(1) In a highly dynamic situation, the inertial sensor's bias will be increased. For instance, the bias 
of an accelerometer with a ±100 g measuring range is approximately 0.1 g to 1 g [8-10]. Under 
such conditions, will the inertial aid still be efficient? 

(2) If the integrated navigation system is starting or re-tracking, or the satellite signal is interfered 
or blocked, the inertial solution error fails to be corrected without the help of integration output. 
Under such conditions, will the inertial aid still be efficient? 

These problems will both result in large offsets or drifts in the inertial aid information. Since the 
code tracking loop is less affected by receiver dynamics, and its dynamic infiuence can be overcame 
through carrier frequency aiding, our research emphasis shall be given to inertially-aided PLL. 

Nowadays most GNSS/INS integrated navigation systems based on inertially aided baseband tracking 
are in the form of tightly integration or ultra-tightly integration [11]. In the 2000s, the GPS/INS 
ultra-tightly integration system was designed and applied [12]. The difference between tight integration 
and ultra-tight integration is that, the tight integration is a cascade of baseband filters and navigation 
filters, whereas the ultra-tight integration is implemented in a single filter based on the estimation of 
baseband signal measurement errors [13,14]. Ultra-tight integration may eliminate the time-correlated 
noise of cascaded filters to improve the tracking sensitivity and navigation precision [15]. Herein, 
according to the baseband of Compass/INS tightly integration, inertially-aided Kalman-PLL is adopted. 
Carrier phase, Doppler frequency shift, and Doppler shift rate are taken as state vectors, and the output of 
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PLL discriminator is used to adjust the Kalman filter gain dynamically. The Doppler shift rate noise is 
relative to satellite-receiver line-of-sight jerk. Normally a small value is taken for the system noise 
covariance matrix Q [3], thus Q will have large error in a highly dynamic situation with large 
line-of-sight jerk, and a traditional Kalman-PLL will result in divergence. The inertial velocity and 
acceleration measurements could help to correct the relevant values of the Kalman states to a great 
extent, but if there is large offset in the aid information, Kalman-PLL will result in filter divergence. 

Hence, it is necessary to consider the influence of Doppler shift rate variation. Doppler shift rate 
value is relative to line-of-sight acceleration, so line-of-sight jerk can be considered as the coefficient 
of Kalman states or noise. Considering that increasing Kalman states will accordingly increase the 
computation burden and large jerk normally has short duration (for jerk 30 g/s, only 2 s are needed to 
reach an acceleration of 60 g), this paper takes line-of-sight jerk as the process noise. Then it is 
feasible to consider a new inertial aid method, using the line-of sight jerk as aid information to adjust 
the noise coefficient of the Doppler shift rate state in real time. 

Line-of-sight jerk can be acquired through time difference of line-of-sight acceleration calculated 
by inertial measurements and Compass ephemeris. The time difference method can eliminate the 
influence of acceleration offset or drift induced by INS bias, but the line-of-sight jerk acquired by the 
time differentiator will have a large noise. The nonlinear tracking differentiator presented by Han 
Jingqing [16] in 1994 can implement the difference of any signal, and it has great filtering capacity. 
Nonlinear tracking differentiator has been efficiently applied to various fields, such as satellite 
navigation [17], magnetic suspension [18] and signal processing [19]. This paper refers to this method 
and its improved versions [20] for achieving smoothed line-of-sight jerk through the inertial 
acceleration with noise, and efficiently aiding high dynamic Compass signal tracking. 

2. Inertial Aided PLL in Compass/INS Integrated Navigation System 

The inertial aided Kalman-PLL is adopted in the Compass/INS integrated navigation system. With 
carrier phase, Doppler frequency shift, and Doppler shift rate as the system states, carrier phase as the 
observation, and phase discriminator output as the innovation, the carrier phase and Doppler frequency 
shift are estimated and used to compute the carrier NCO, as shown in Figure 1 [21]. 

Figure 1. Inertial aided PLL in Compass/INS integrated navigation system. 
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The system matrix of Kalman-PLL is demonstrated as: 
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where t is the loop update interval. The process noises are approximated as white noises: 

where the covariance matrix of the process noise Qk is related to receiver's djniamic characteristics. 
The measurement matrix of Kalman-PLL is demonstrated as: 



(2) 
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Observation noises are also approximated as white noises: 

E(v,) = 0 



(4) 



The covariance matrix of observation noise Kk is determined by carrier phase tracking noise due to 
thermal noise, vibration noise, ionosphere scintillation, noise of oscillator and other sources. 
Adopt an arctan phase discriminator, and the output of phase discriminator is demonstrated as: 



= atan(e^//^) 



(5) 



where, Qp, Ip are the quadra-phase output and in-phase output of baseband correlator prompt channel. 
Take the PLL discriminator output d(f)k as the observation innovation, that is: 



The computation of Kalman-PLL is presented with two steps, prediction and update: 
Prediction: 



(6) 



^ k+l k ^k * k Vk* k 



(7) 



Update: 



- Pk Hk (H^Pk + Rj^ )^ , 
^k = ^k + (Z^ - H^X^ ) = Xk + K^Z^/^_i, 
P; = (I - K,H, )P, (I - K,H, f + K,R,K,^ 

where Kk is the optimal gain matrix. 



(8) 
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The carrier NCO is: 



ZTTT 

where, <pk is the carrier phase, Afj^ is the Doppler frequency shift, and Afj^ is the Doppler shift rate. 
The superscript denotes the updated measurement and the superscript denotes the 
predicted measurement. 

The essential part of inertial aided tracking is to use the inertial aid information to predict the 
Doppler frequency shift, and then eliminate the loop's dynamic stress error. The traditional aid method 
is velocity aiding, and acceleration aiding is also practical [22]. 

The velocity aid method involves computing the Doppler frequency shift through the line-of-sight 
velocity, and correcting the estimated Doppler frequency shift before the update step (8), as shown in 
Equation (10): 

f 

4/;= — v,e, (10) 
c 

Acceleration aiding involves computing the Doppler shift rate through the line-of-sight acceleration, 
and correcting the estimated Doppler shift rate before the update step (8), as shown in Equation (11): 

• f 

¥k=—^k^k (11) 

c 

where Vk is the line-of-sight velocity vector, ak is the line-of-sight acceleration vector, and Ck is 
line-of-sight unit vector. In a highly dynamic situation with satellite-receiver line-of-sight jerk, if there 
is large offset or drift in inertial aiding information, the aided Kalman-PLL will diverge. 

3. Inertial Aiding Method Based on a Nonlinear Tracking Differentiator 

3.1. Jerk Aided Kalman-PLL 

The process noise covariance matrix Qk of Kalman-PLL is demonstrated as [21]: 

0 0 0 



0 0 0 



0 0 n{.j 



(12) 



where n^^ denotes the Doppler shift rate PSD, that is: 

4,^ = ^'(A/;-4/;_i)/T (13) 

The Doppler shift rate value is related to satellite-receiver line-of-sight acceleration. Parameters of 
process noise covariance matrix Qk are related to the line-of-sight jerk. When the line-of-sight jerk is 
constant or it varies slowly, n^^- can be set as a very small constant. However, if the line-of-sight jerk 

is large, the process noise characteristic is unknown, and filtering divergence might occur. There are 
two solutions to such a problem: the first one is to estimate the receiver's dynamic characteristics 
through adaptive algorithms, and adjust the coefficients of process noise covariance matrix [23,24]; the 
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second one is to introduce inertial aiding information [25], and carry out real time correction of the 
process noise covariance matrix during the prediction step. 

The Doppler shift rate is related to satellite-receiver line-of-sight acceleration, is demonstrated as: 



= (7\Af,-Af,_,)/T 



f 

J ca 



(14) 



c 



where fca is the carrier frequency, c is the hght velocity, ak is the sateUite-receiver Hne-of-sight 
acceleration vector. 

The jerk aided PLL involves performing time difference of line-of-sight acceleration, obtaining 
the line-of-sight jerk, and correcting the process noise matrix relevant coefficient n^^^ of the 

Kalman-PLL according to Equations (12) and (14). 

3.2. Jerk Aided Kalman-PLL Based on Nonlinear Tracking Differentiator 

If the input signal with noise is y{t), its differential x{t) can be deduced by a time differential 
method. Generally the time differential method is as follows: 

y{t)-y{t-T) 



x(t) = 



(15) 



The above equation matches Equation (14), and this differential operation will increase the noise. 
Using the nonlinear tracking differentiator, the smoothed output y(t) and its differential x(t) can be 
obtained through the input j;(0, and the equation is as the following: 

y(t + T) = y(t) + T'x(t) 
x(t + T) = x(t) + T • f(e, x(t)) ( 1 6) 

e = m-y(0 



where z is sampling interval, /(*) is nonlinear function. The function^-) used herein is [26]: 



f(e,x{t)) = ^' 
where the function fal(-) is expressed as [26]: 

fal(x, a, 5) = 



x(t) 

-a^e - a^ fal(e, a, 5) - a2 fal( , a, 5) 

R 



(17) 



I x'^sign(x), |x| > 6 
x/^'-",UI<5 



(18) 



If R is larger, the tracking is faster, but the noise will be accordingly increased. The nearer a 
approaches 1, the more the system approaches linearity. The setting of threshold value d is in order to 
prevent the system from vibrating in the origin, and d should be far less than 1 . Here, we select the 
parameters as follows: set T as per sampling frequency and R = 2, ao = 60, ai = 60, a2 = 60, a = 6/9. 
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3.3. Data Verification of Nonlinear Tracking Differentiator 

Firstly, let us take the Micro-Electromechanical System (MEMS) acceleration data collected under 
static conditions as an example (Figure 2(a)), and estimate the jerk with a time differentiator and 
nonlinear tracking differentiator, respectively; the results are shown in Figure 2(b) where the blue 
curve stands for the jerk obtained with the time differentiator and the red curve stands for the jerk 
obtained with the nonlinear tracking differentiator. Table 1 shows the offset and noise standard 
deviation (std) of estimated jerk under static conditions with the two methods. 

Figure 2. Jerk estimated from the MEMS acceleration with the two methods (a) MEMS 
acceleration; (b) Jerk estimated with the two methods. 
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Table 1. Offset and noise standard deviation of estimated jerk in static condition with the 
two methods. 





Estimated jerk by time 


Estimated jerk by nonlinear 




differentiator (m/s^) 


tracking differentiator (m/s^) 




X y z 


X y z 


offset 


0.0001 0.0002 0.0001 


0.00003 0.00004 -0.00008 


std 


0.1911 0.1870 0.2026 


0.0565 0.0567 0.0619 



Secondly, let us take the simulated line-of-sight acceleration with 50 g to 80 g variation within one 
second as an example (Figure 3(a)). The offset of simulated acceleration is 0.1 g, and the noise 
standard deviation is 0.1 g. We compare the jerk obtained with the time differentiator and nonlinear 
tracking differentiator, respectively, and the results are shown in Figure 3(b). Table 2 shows the 
offset and noise standard deviation (std) of estimated jerk in the high dynamic condition with the 
two methods. 
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Figure 3. Jerk estimated from the simulated high dynamic acceleration with the two 
methods (a) Simulated high dynamic acceleration; (b) Jerk estimated with the two methods. 
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Table 2. Offset and noise standard deviation of estimated jerk in high dynamic condition 
with the two methods. 





Estimated jerk by time 


Estimated jerk by nonlinear 




differentiator (m/s^) 


tracking differentiator (m/s^) 


offset 


2.7396 


0.0059 


std 


1,359.8 


13.7883 



As shown in Figures 2(b) and 3(b), the nonlinear tracking differentiator can overcome the time 
differentiator's disadvantage of enlarging noise and time delay. For Compass/INS integrated 
navigation system, if the following situation occurs: 

(1) Because the inertial measurement unit with wide measuring range has large bias, the 
acceleration aiding information will have a constant offset; 

(2) When the integrated navigation system is starting, or the satellite signal is interfered or 
blocked, the integrated navigation output will be halted. The inertial error will fail to be 
corrected, and the inertial error will be enlarged gradually with time. 

Under general conditions, the third-order PLL or traditional inertially-aided PLL can track the 
satellite signal with any line-of-sight acceleration. If the above situation occurs and the receiver-satellite 
line-of-sight jerk is large, it is feasible to track the high dynamic signal with the proposed jerk aided 
PLL, i.e., estimate the line-of-sight jerk through inertial acceleration based on a nonlinear tracking 
differentiator, and adjust the process noise matrix coefficients of the Kalman-PLL. 

4. Experiments 

Due to the limited hardware conditions and difficulties in collecting actual high dynamic satellite 
signals and synchronous inertial measurement data, it is optimal to use: (1) the high dynamic simulated 
intermediate frequency data generated by Matlab; (2) the high dynamic data collected based on GNSS 
signal simulator to verify the proposed aiding methods. 
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4.1. Simulation Test Based on Matlab 

First of all, we use the simulated high dynamic GNSS intermediate frequency data generated by 
Matlab and synchronous line-of-sight aiding data to verify the PLL performance with the following 
three aid methods and make a comparison: 

Aid method 1 : PLL without assistance 
Aid method 2: acceleration aided PLL 

Aid method 3: jerk aided PLL based on a nonlinear tracking differentiator 

The above three aid methods are all based on Kalman-PLL. The acceleration-aided PLL involves 
adjusting the value of Kalman states according to Equation (11), and the jerk aided PLL method 
involves adjusting the process noise matrix coefficients of the Kalman filter according to Section 3. 

The one second duration high dynamic intermediate frequency data produced by the Matlab satellite 
signal simulator is used here, and the SNR is -15 dB. As shown in Figure 4, the receiver's 
dynamic characteristic is: the initial line-of-sight velocity is 7,000 m/s, initial line-of-sight acceleration 
is 50 g and jerk is constant 30 g/s. Consider the conditions of aiding line-of-sight acceleration error as: 
the line-of-sight acceleration offset is 1 g [8-10], noise standard deviation is 0.1 g. See Figures 5 and 6 
for the tracking results. 

Figure 4. The high dynamic characteristics of simulated signal (line-of-sight direction). 
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As shown in Figure 5, where the line-of-sight acceleration bias is 1 g, noise standard deviation is 
0.1 g, the PLL without assistance will fail to track; the acceleration-aided PLL can track in short 
duration scenarios, but long-duration tracking precision will be lowered; the jerk- aided PLL can track 
stably. As shown in Figure 6, the Doppler frequency estimated with the jerk- aided PLL is about 29,700 
to 32,300 Hz, and the estimated Doppler shift rate is about 2,200 to 3,400 Hz/s, which matches with 
the receiver's dynamic characteristics. 



Sensors 2012, 12 

Figure 5. (a) Comparison of the in-phase output; (b) Comparison of the tracking errors. 



7643 



X 10 



0- 



PLL without assitance 



X 10 



100 200 300 400 500 600 700 
acceleration aided PLL 



900 1000 



55 0 



0 100 200 300 400 500 600 700 800 900 1000 
X 10^ jerk aided PLL based on nonlinear tracking differentiator 



0 100 200 300 400 500 600 700 800 900 1000 
time(ms) 



(a) 



PLL without assitance 



S 0.5 



-0.5 



0.05 



100 200 300 400 500 600 700 800 900 1000 
acceleration aided PLL 



-0.05 



0.05 



100 200 300 400 500 600 700 800 900 1000 
jerk aided PLL based on nonlinear tracking differentiator 



-0.05 



^ 0 i^f 4l|HirtfHrtf|i|^|^ 



100 200 300 400 500 600 700 
time(ms) 



900 1000 



(b) 



Figure 6. Estimated Doppler frequency and Doppler shift rate with jerk aided PLL. 
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It is concluded on the above experimental results of simulated high dynamic signal that if there is a 
large offset or drift in the inertial aid information, the jerk- aided PLL based on a nonlinear tracking 
differentiator can be efficiently used to track the Compass B3 signal with line-of-sight jerk of 30 g/s. 

4.2. Test Based on GNSS Signal Simulator 

The next used the Compass B3 signal collected with the GNSS signal simulator to verify the 
proposed aid method. The experimental facility consists of a control computer, a GNSS signal 
simulator, a radio frequency front end and a high-speed data collection card, as illustrated in Figure 7. 
The GNSS signal simulator can output radio-frequency signals of various constellations. The control 
computer provides the GNSS signal simulator with the functions of scene editing, downloading and 
running state monitoring (including simulation time, satellites state, and user trajectory). Users can 
customize scenes according to their necessary receiver dynamic characteristics. It also provides special 
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scenes with satellite-to-receiver relative motion. After the radio-frequency signal collection, we 
implement intermediate frequency signal acquisition and tracking in a Matlab based software receiver. 



Figure 7. The test system composition based on GNSS simulator. 
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The test adopts the scene of satellite-to-receiver relative motion, with the initial line-of-sight 
velocity of 8,000 m/s, initial acceleration of 100 g, constant jerk of 10 g/s, signal power of -1 10 dBm. 
We collect intermediate frequency data for a duration of 6 seconds. Taking the PRN 6 satellite signal 
as an example, it is difficult to obtain the correct line-of-sight acceleration, so the jerk- aided PLL 
based on the nonlinear tracking differentiator is verified according to the constant line-of-sight jerk of 
10 g/s. The performance of jerk-aided Kalman-PLL is compared with the PLL without assistance. The 
results are shown in Figures 8 and 9. 



Figure 8. Phase tracking errors comparison of GNSS simulator collected signal. 
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Figure 9. (a) Doppler frequency and Doppler shift rate estimated by PLL without 
assistance; (b) Doppler frequency and Doppler shift rate estimated by jerk aided Kalman-PLL. 
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Figure 8 shows the comparison of carrier phase tracking errors. It is concluded that the PLL without 
assistance fails to track, but the jerk- aided Kalman-PLL can perform stable tracking with a phase 
tracking error of about 13°. As shown in Figure 9, the Doppler frequency and frequency shift rate that 
are estimated by the PLL without assistance cannot reflect real dynamic characteristics, however, the 
values estimated by jerk-aided Kalman-PLL match with the receiver dynamic characteristics. 

From the test results based on the GNSS simulator, the jerk-aided Kalman-PLL can efficiently track 
the highly dynamic GNSS signal with constant line-of-sight jerk of 10 g/s. Meanwhile, it is concluded 
from Figures 2 and 3 that high precision line-of-sight jerk can be estimated with the nonlinear tracking 
differentiator. In result, the high dynamic Compass B3 signal can be efficiently tracked with jerk- aided 
Kalman-PLL in the Compass/INS integrated navigation system, by using the inertial acceleration 
measurements to estimate line-of-sight jerk based on the nonlinear tracking differentiator, and 
adjusting relevant coefficients of the process noise matrix of the Kalman-PLL. 
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5. Conclusions 

This paper introduces a jerk-aided Kalman-PLL in the Compass/INS integrated navigation system, 
where the jerk is estimated through inertial acceleration measurements based on the nonUnear tracking 
differentiator. This aid method can eUminate the impact of inertial error on the aided tracking loop. 
Based on the test of high dynamic Compass B3 signals collected by the GNSS simulator, it is 
concluded that the proposed new aid method can efficiently help track highly dynamic signals with 10 
g/s line-of-sight jerk. In conclusion, if the Compass/INS integrated navigation system is starting or 
re-tracking after losing lock, the inertial error correction by integrated navigation solution hasn't been 
implemented, then the jerk- aided Kalman-PLL based on the nonlinear tracking differentiator as 
presented herein can work efficiently. 
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